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Description 

FIELD OF THE INVENTION: 

5 [0001 ] This invention relates generally to the control of motors and, in particular, to the control of stepper motors such 
as those employed in robotics and rapid prototyping applications. 

BACKGROUND OF THE INVENTION: 

10 [0002] High performance robotic systems may use closed loop control such as position, velocity, and acceleration 
serYsors. feedback and feed forward calculations, and signal filtration. The use of feedback enables a level of perform- 
ance near optimal levels of speed and accuracy fcx point-to-point nwes. 

[0003] As an example, a robotic system that is adapted for a rapid prototyping system (RPS). and that employs feed- 
back to control a position of an extrusion nozzle in an x-y-z coordinate reference frame is disclosed in US-A-5.303.141 
IS published on 1 2.04. 1 994 which does however not form part of the pria art. 

[0004] An example of the generally applied use of feedback in robotics, through the use of encoders and possibly 
tachometers, is shown in US- A-4. 749.347. 

[0005] However, for low cost robot acti^tors the additional cost of providing feedback sensors and servo amplifiers 
may be prohibitive. 

20 [0006] Synchronization of multiple axis motion may also be required in robotic applications. Master/slave techniques 
are typically used, such as described In T^ultl-axis Controller", by R.C. Russell, US-A-4.41 5.967. 
[0007] The closest prior art EP-A-0440805 discloses generally a method according to the preamljle of claim 1. for 
controlling the feed speed of a tool moving along a machining path in accordance with a machining programm. The 
method derives a correct feed speed. 

25 [0008] Optimization of a point-to-point move time may not, however, optimize the total nrx>ve time over a trajectory. In 
an application of particular Interest, the problem that Is addressed by this Invention can be understood by comparing 
two simple trajectories. 

[0009] In a first case. 1 000 line segments each 2.54 x lO '^m (0.01 inches) long are concatenated to form a circle with 
a diameter of 8.08 x 10'^m (3.18 inches). Ignoring truncation effects due to the finite step size possible along each axis, 
30 the maximum speed that a robot should make this circular move is dictated by the amount of centripetal acceleration 
that the mechanism can accurately sustain. For a typical case of 0.3 g's of acceleration, the robot should be able to 
negotiate the cirde at an average peak speed of 0.345m (13.6 inches) per second, not including the portions required 
for longitudinal acceleration and deceleration. 

[0010] in a second case. 1000 moves of 2,54 x lO '^m (0.01 inches) form a stair case so that there is a 90 degree turn 

35 between each segment If it is assumed that the step size should set the desired accuracy of the system, then the 90 
degree changes of direction rtiust be accomplished in a single motor step. Again for 0.3 g*s of acceleration, and assum- 
ing a typical step size of 7.62 x 1 0'^m (0.0003 inches), it is found that the velocity at the corners is maximally 3.35 x 1 0" 
^m (0.132 inches) per second. Even assuming that the robot accelerates and decelerates as fast as possible on the 
segments between the corners, the maximum velocity on average is 2.67 x 10'^m (1.05 inches) per second, more than 

40 an order of magnitude slower than for the first case. 

[001 1 ] Clearly, it is necessary to kx>k ahead a considerable distance to determine the nature of the trajectory. If there 
are sharp turns coming, the velocities should be sufficiently reduced so that acceleration limits are not exceeded. It is 
also desirable to use the acceleration capabilities of the robot to the greatest extent possible, which means that the 
robot should preferably always either be accelerating or decelerating. 

45 [0012] Several known types of high performance robots controllers measure instantaneous position, velocity, and 
acceleration, and use this Infbnnation with feed forward correctk}ns based on the coming trajectory to control straight 
line point-to-point moves. These real time controllers use the fastest available digital signal processor hardware, but are 
constrained to look, at most, two point-to-point moves ahead. As was indicated in the foregoing example, such a short 
look-ahead approach can require a significant transit time over a trajectory, as compared to a trajectory that has been 

50 globally maximized. 

SUMI^ARY OF THE INVENTION 

[001 3] It is an object of this invention to accurately predict how the kinematics of a rotx)t will dictate the detailed char- 
55 acteristics of a time optimized.ti'ajectory, and to then use a simple, time based controller to generate the actuator pulse 
trains required to realize the trajectory. 

[0014] It is a further object of this invention to provide a method for accomplishing trajectory optimization before the 
execution of a robot movement. 
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[001 5] Another object of this invention is to provide a method that enat)les a look-ahead length of thousands of straight 
line point-tOiX)int moves, using currently available microprocessor technology, to yieW a globally optimized trajectory. 
[001 6] A further object of this invention is to provide a method for pre-processing a desired trajectory to optimize motor 
drive sequences so as to traverse the trajectory as rapidly as is possible, and without exceeding the mechanical con* 

5 traints of the underlying rotx)tics system. 

[0017] The foregoing and other problems are overcome and the objects of the invention are realized by a method for 
determining a globally optimal trajectory and velocity for a motor-driven robot. The method utilizes a deflection angle 
calculation of a maximal velocity for each vertex, a heap sort for globally ensuring that none of the vertices have an 
excessive velocity, and a vertex adding technique that ensures that the robot is performing straight line moves as rapidly 

10 as is possible. 

[001 8] More particularly, this invention provides a method for deducing a time required for an object to be driven by a 
plurality of motors over a predetermined trajectory through an n-dimensional space, wherein n Is equal to or greater 
than two. The trajectory is defined by a plurality of vertices each having coordinates that define a location within the n- 
dimensional space. The method is characterized by the steps of: (a) providing a set of vertices that define a desired 

IS trajectory, each vertex being separated from at least one other vertex by a line segment; (b) for each vertex, determining 
a maxinmjm velocity that can be sustained while translating tiie object tiirough a point in tiie trajectory that corresponds 
to the vertex; (c) modifying the vertex list, if required, to achieve a velocity profile over tfie trajectory that causes tiie 
object to traverse the trajectory In the shortest period of time, without exceeding the maximum velocity at any vertex; 
and (d) translating the modified vertex list into motor drive signals for causing the plurality of motors to translate the 

20 object in accordance witii the modified vertex list. 

[0019] In an open loop robotics system, tiiat operates in accordance with the mettiod, the motors are stepper motors 
that move a step distance of dj in response to drive signal pulse, where J is the number of degrees of freedom, and 
where ^ <. \^J, Translating the object through a point in the trajectory from a vertex i-1 to i to i+1 is shown to result in a 
deflection of angle d\. An aspect of this invention employs a value of cos6 , to determine a delay time between drive 

25 signal pulses for a stepper motor associated with an axis having a fastest movement, also referred to as a master axis. 
[0020] The step of nrKxiifying includes the steps of: (a) determining a velocity profile over a run lengtii corresponding 
to tfie desired ti-ajectory, the velocity profile being determined in accordance with a dynamic characteristic of the stepper 
motor, such as torque; (b) testing an effect of maximum accelerations and maximum decelerations between pairs of 
vertices to determine if a resulting vefocity would exceed the determined maximum velocity at one of the vertices of tiie 

30 pair; and (c) adjusting the velocities of vertices to enable the use of maximum accelerations and decelerations between 
vertices, and inserting, if required, one or more intermediate vertices between the vertices of the pair. 

BRIEF DESCRIPTION OF THE DRAWINGS 

35 [0021] The above set forth and otiier features of the invention are made more apparent in the ensuing Detailed 
Description of tiie Invention when read in conjunction with the attached Drawings, wherein: 

Fig. la is a block diagram of a rapid prototyping system that includes a robot that positions a fabrication tool in 
accordance witii this invention; 

40 

Rg. lb is a block diagram of a furttier embodiment of tiie invention; 

Rg. 2 graphically depicts a velocity determination technique employed by the invention; 

45 Rg. 3 graphically illustrates an exemplary desired trajectory for a robot, the trajectory including a plurality of verti- 
ces; 

Rg. 4 is a plot of computed vertex velocities; 
so Fig. 5 graphically depicts a stepper motor torque cun^e; 

Rg. 6 graphically depicts a resulting velocity proffle for the torque curve of Fig. 5; 
Rg. 7 plots velocity indices against run lengtii; 

55 

Rg. 8 illustrates a revised plot of velocity indices against run lengtii. after applying a step of the flowchart of Rg. 10; 
Rg. 9 illustrates a furtiier revised plot of velocity indices against run lengtii. after adding vertices in accordance with 
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the flowchart of Rg. 10: and 

Rgs. 10a and 10b depict a flowchart illustrating a presently preferred method of the invention. 

5 DETAILED DESCRIPTION OF THE INVENTION 

[0022] Rgure 1 a Is a block diagram that illustrates the use of the invention in a rapid prototyping system 1 0. A robot 
is generally indicated by the numeral 1. The robot 1 includes a real time controller 12 having outputs 12a-12d coi^jled 
to a plurality of stepper motors (SMI -SM4). The stepper motors operate in a conventional fashion so as to provide an 

10 incremental rotation (step) of a shaft in response to an input pulse. The stepper motors can also be of the type that pro- 
vide an incremental linear nnotion of an actuator element in response to an input pulse. The stepper motors are 
mechanically coupled to a tool 14 that is used in the rapid prototyping process. By example, the tool 14 is an extrusion 
nozzle that is coupled to a pump 1 5 which provides a source of extrudate. such as a polymer The end result is the con- 
trolled deposition of beads 16 of extrudate so as to form a three dimensional model of an object of interest The illus- 

15 trated system is a four degree of motion system wherein the tool 14 is translated within an x-y-z coordinate reference 
frame by the action of the stepper motors SM1-SM3. plus the extrusion rate of the nozzle controlled by SM4. It should 
be realized that one or more of the stepper motors can be mechanically coupled to a support structure (not shown) that 
supports the object during the fabrication thereof. In this type of system the tool 14 may be provided with several 
degrees of freedom, as n^y be underlying support structure. 

20 [0023] The step size along each axis defines the accuracy to which the position along that axis will be determined [± 
of the step size). The deflection angle calculation assumes errors of the order of V4 step size are acceptable so that 
finite deflection angles can be navigated at reasonable velodties. If, instead of a stepper motor, it is desirable to use a 
synchroneous motor and encoder, the following analysis will also apply as long as 2X the positioning error of the closed 
loop system is used instead of the step size of the stepper motor. 

25 [0024] If a microstepping stepper motor driver is used, then subsequent references to a ''step" should be interpreted 
as "microstep". 

[0025] n Is pointed out that the robot 1 is an open loop system and does not require the use of positional or other 
types of feedback to control the positioning of the tool 14. 

[0026] It shoukJ also be appreciated that the use of an extrusion nozzle for the tool 14 is exemplary only, in that the 
30 tool 14 could comprise, by exanple, a laser or a means for directing a laser beam so as to cure a photopolymer. as is 

accomplished in stereolithography prototyping systems. Also by example, the tool 14 could be a device, such as a laser 

or a nozzle for directing a flow of abrasive material, so as to selectively remove material from a block of material. 

In general, the teaching of this invention can be applied with advantage in any robotic system where performance is 

determined by navigating a complex path quickly (at non-uniform velocity). Such applications include flatbed and drum 
35 plotters, maze following, glue and caulk applications, film patterning, and solder paste extrusion. The teaching of this 

invention may also be used, although with less benefit, in appfications requiring constant feed rates, such as machining 

and painting. 

[0027] That is, the teaching of the invention is applicable to three dimensional prototyping systems that operate by 
additive or subtractive methods. Furthermore, the teaching of this invention is applicable to applications other than rapid 

40 prototyping systems, particularly applications wherein it is desired to oontroltably position and/or translate an object 
[0028] In accordance with the teaching of this invention, a processor 1 8 has an output 1 8a coupled to an input of the 
controller 12 and provides a vertex list that is optimized to most efficiently utilize the robot 1 . The operation of the proc- 
essor 18 is described in detail below. The processor 18 has an input 18b for receiving a vertex list from a source, such 
as an interactive Conputer Aided Design (CAD) system. The vertex list that is output by the CAD system may be a 

45 specification of at least an outer shell, and possibly also internal support stmctures. of a three dimensional object to be 
fabricated by the robot 1. The generation of such vertex lists, based upon an operator's input, is well known in the art. 
and will not be further described in detail. In general, the vertex list specifies the desired nxition of the system by a 
sequence of straight line segments from one vertex to the next. 

[0029] What Is now described is a presently prefen'ed method for determining the least time nx>tion of the stepper 
50 motor driven robot 1 through a given trajectory. 

[0030] The method assumes that the following conditions exist. 

1 . A set of vertices or points in 2 space, 3 space, or higher dimensionality (additional degrees of freedom) are given 
that define a desired piecewise linear trajectory for an object: V"/ s (x,, y,, z,, p|, ...) 1 ^i^N, 

55 

2. A spatial position of an object is manipulated by stepper motors with known dynamic cfiaracteristics. such as 
torque curves and time responses. 
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3. The mechanical characteristics of the rolx>tic manipulator are not time dependent. 

[0031 ] A first goal is to cause the rotx>t 1 to traverse the desired trajectory as quickly as possible. A second goat is to 
accomplish this process as inexpensively as possible. This second goal suggests an open loop (no feed bad^ stepper 
5 motor system. To maintain the computational requirements to a minimal level, a related goal is to predetermine an opti- 
mal control sequence (i.e. which stepper motors to pulse at what times), allowing the inexpensive real-time controller 
12 to execute the predetermined sequence. 

[0032] A presently prefened embodiment of the method is shown in the flowchart of Figs. 10a and 10b. 

[0033] The method op^'ates to reduce a time required for an object, such as an extrusion nozzle, to be driven fcyy a 

to plurality of motors (such as SM1-SM4} over a predetermined trajectory through an n<limensional space, wherein n is 
equal to or greater than two. The trajectory is defined by a list of vertices each having coordinates that define a location 
within the n-dimensional space, each vertex being separated from at least one other vertex by a line segment. A vertex 
pair is considered to be two vertices that are nearest neighbors along the trajectory and that are separated by a single 
straight line segment. 

15 [0034] The method executes the following steps: 

(A) determining a maximum velocity that can be maintained for each vertex as the object changes direction when 
being driven from one line segment to the next; 

20 (B) sorting the vertices by ascending maximum velocity; 

(C) examining a pair of vertices consisting of the slowest vertex and a subsequent vertex in the trajectory; 

(Da) if the determined maximum velocity at the subsequent vertex Is found to be exactly achieved by accelerating 
25 as fast as possible from the slowest vertex. ' 

(Db) marking the determined maximum velocity at the sut)sequent vertex as correct; 

(Oc) if the determined maximum velocity at the subsequent vertex is found to be greater than the determined max- 
30 imum velocity, 

(Dd) reducing the maximum velocity for the subsequent vertex to the value achieved by accelerating as fast as pos- 
sible from the slowest vertex; and 

35 (De) marking the reduced maximum velocity at the subsequent vertex as con-ect. 

[0035] If the determined maximum velocity at the suk)sequent vertex is found to be less than the determined maximum 
velocity, a next step 

40 (Df) marks the subsequent vertex for a subsequent addition of at least one intermediate vertex. 

[0036] The method then examines a pair of vertices consisting of the slowest vertex and a previous vertex in the tra- 
jectory. 

45 (Ea) If the determined maximum velocity at the slowest vertex Is found to be exactly achieved by decelerating as 
fast as possible from the previous vertex to the slowest vertex, the method executes the steps of, 

(Eb) marking the maximum velocity at the previous vertex as correct; 

50 (Ec) if the determined maximum velocity at the previous vertex is found to be greater than the determined maximum 
velocity, 

(Ed) reducing the maximum velocity for the previous vertex to the value achieved by decelerating as fast as possible 
from previous vertex to the slowest vertex; and 

55 

(Ee) marking the reduced maximum velocity of the previous vertex as connect; 

if the determined maximum vek)city at the subsequent vertex is found to be less than the determined maxi- 
mum velocity. 
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(Ef) marking the previous vertex for a sid)sequent addition of at least one intermediate vertex. 
(F) A next step removes the vertex having the lowest maximum velocity from the vertex list; and 

5 (G) determines if all vertex pairs have been examined. 

If NO at step G, the method repeats the steps (B) through (G); else 
if YES at step G, the method 

(H) adds at least one intermediate vertex between each vertex pair previously marked tor vertex addition at a 
10 velocity conesponding to maximally accelerating from the previous vertex, and deccelerating towards the sub- 

sequent vertex; and 

(0 detemrtines from the resulting vertex list a sequence of motor control signals that will cause the otsject to be 
driven over the trajectory so as to achieve the indicated velocities at each vertex of the resulting vertex list 

15 

[0037] That is, the resulting vertex list is downloaded from the processor 1 8, via cable 1 8a. to the controller 1 2, which 
then determines from the vertex list the stepper motor pulse trains for SMI -SM4 to achieve the optimum motion of the 
robot 1 and. hence, the fabrication tool 14. 

[0038] In that in Fig. 1a the motors are stepper motors, step (H) adds a single vertex if a full acceleration from the first 
20 of the pair of vertices, and a full deceleration to the second of the pair of vertices, results in a position, along the line 
segment connecting the pair of vertices, where the accelerating and decelerating velocities are the same, and which is 
an integer number of stepper motor steps from both vertices, and where the velocity at the intersection is less than a 
maximum allowable velocity, 

[0039] If a full acceleration, followed by full deceleration, along the line segment between tiie pair of vertices will cause 
25 the velocity to reach a maximum allowable velocity, the step (H) adds a first vertex at a point on the line segment where 
the velocity first reaches the maximum allowable value, and a second vertex at a point on the line segment whereat a 
full acceleration will result in the second vertex being reached at the determined maximum velocity. 
[0040] If a full acceleration ramp and a full dec9leration ramp intersect at a non-integer number of stepper motor 
steps, the step (H) adds two vertices along tiie line segment that are separated t>y one stepper motor step tiiat results 
30 in neither an acceleration or a deceleration. 

[0041] The real time stepper motor controller 12 must know at what rate and in what direction to pulse each motor 
SM1 -SM4 during the entire trajectory. While not necessary, it will be assumed in what follows that the conf oiler 12 per- 
forms a software delay to determine the time between the pulses to the axis requiring the most numbers of steps over 
a particular segment (refened to herein as the dominant axis for tiiat segment). It is further assumed tiiat pulses to tiie 
35 otiier axes are produced coincident witii ttie dominant axis pulses, and uniformly disti-ibuted along tiie segment. This is 
done by interpolation and truncation (see haul Q)- 

[0042] An important feature in the implementation of the method is the use of a heap sort to find tiie next lowest veloc- 
ity vertex, and to re-sort the two nearest neighlwr vertices if their velocities are altered. For N vertices, the vertex list is 
re-sorted maximally N-2 times (the number sorted decreases by one with each sort). As a result, it is desirable tiiat tiie 
40 sorting process be efficient. The heap sort provides a log (N) sort time, and identifies tiie lowest velocity remaining ver- 
tex (the top of the heap). A suitable heap sort algorithm is disclosed by R. Sedgewick. Algorithms. Addison-Wesley. New 
York, 1988. ISBN 0-201-06673-4. pp. 132-139. 

[0043] Anotiier inportant time-saving feature in ttie implementation of the method is an efficient and reliable means 
to determine the maximum velocity associated with a given vertex. 
45 [0044] In this regard, it is assumed that tiie Pytiiagorean lengtii of both segments adjoining a vertex has been prede- 
termined. For a rapid prototyping application this is generally true because the length of each segment determines an 
amount of material to be added or removed. For a rapid prototyping system having an extrusion head, tiiis implies that 
a required number of extrusion pump steps has been predetermined for each segment connected at a given vertex. 
[0045] It is noted that, for 3% rms accuracy. 



50 



max = maximum of{ |x|,|y|.|z| ) 



7/ I I 4373(max) ^ 3062(|x| ^ |y| ^ |z|) 



2 13 



[0046] It is also assumed that each axis is independent, and that tiie time response of each axis is approximately the 
same. The numbers appearing in ttie numerator are derived from a numerical fit. 
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[0047] If axis I moves a distance di for each step, and if the average acceleration from a standing start for axis i is a,-, 
a relationship for the time required to take the first step is given by: 




[0048] While the loads and forces on each axis n^y be different, the step distance d/ can be adjusted for each axis 
so that the response time Tj is approximately the same for all axes. 

[0049] Using these assumptions, the velocity associated with each vertex can be determined as shown in Fig. 2. 
[0050] In moving from vertex i- 1 to i to i+1 . the trajectory is deflected by Oj. where 



[0051 ] It is assumed that the only acceleration at the vertex is centripetal; i.e. the velocity along the direction of motion 
is constant 



l^^/l = l^vil=f. 



where t is the minimum time per step for any axis, and d is the step distance of the highest velocity axis. f=br small 
deflection' angles, the average centripetal acceleration is 



solving for the time per step yields: 

T;= /-^^ VI -cose 

[0052] Since is the same for all axes, the time delay between pulses is independent of the direction of motion. 
[0053] Since the segments are linear, the cos (Oi) can be determined as: 

coc(e,)^ •^^r^u^^^PrPi^^ 



r~2 2 2 2 r~2 2 2 2 * 

JXf +Pf +y/^i 



[0054] Tlie determined value of cos (Oj) is preferably used to index into a look-up table to obtain the delay time t, 
between pulses for the fastest nrwving axis, also referred to as the master axis. It shouW be noted that the master axis 
may also be defined to be a virtual axis having an associated movement that is fester than any of the real axes. Clearly, 
the velocity of vertex i becomes 




[0055] It is not necessary for the response times of each axis to be the same, or for the different axes to be Independ- 
ent The determination of the velocity of a given vertex is similar, but more involved in these cases. 
[0056] With respect to the re-setting of vertex velocities, a procedure that guarantees that the robot does not reach 
any vertex with more velocity than a maximum velocity when going around that vertex is best understood with respect 
to Fig. 3, which illustrates an exemplary robot trajectory in x-y For a given segment i. let 
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max I = maximum lyj, [z J. Ip,.|), define run length f = ^ 

/"I 

5 (similar to the total length traveled). A plot of the computed vertex velocities with respect to run length is shown in Fig. 4. 
[0057] A slightly non-standard scale for velocity is used to facilitate later calculations. If the torque curve for a nx)tor 
is nfKXfeled as torque = Tst^Q - K • RPS , as shown in Fig. 5, it is found that the velocity profde is 

vW = v,(1-e-n 

as shown in Rg. 6. 

[0058] In the prefen-ed implementation, using a microprocessor for the controller 1 2, the velocity of an axis is 
'5 v = d/{n*Tj,.) 

where d is the step distance, is the time for a single software delay loop, and n is the number of delay loops executed. 
[0059] A velocity rarrp is established as an indexed aray of delay loop counts {nj. An acceleration thus involves the 
20 use of. by example, nj^^ delay loops for a next step. Therefore, only a discrete number of velocities Vj are available: 

Vj = d/(njTd.) 

25 [0060] The method of denoting velodties by an integer index value and move distances by cumulative master axis 
steps is useful because an acceleration always appears as a +45** slope line, and similarly a deceleration is a -45** slope 
line. The object is to provide a velocity index, with respect to run length, of a type shown in Fig. 7, and to therefore con- 
nect all vertices with ± 45'' sloped lines. In the case shown in Fig. 7, only vertices 9-10 are so connected. 
[0061] Fig. 8 shows the result of applying steps C, D and E as described with respect to Figs. 10a and 10b. Vertices 

30 that are too fast to be achieved with the nominal acceleration from either nearest neighbor vertices are thus reset to 
lower velocities. 

[0062] Having determined vertices with optimal "correct" velocities, and having reset the velocities of fast vertices, as 
required, vertex addition is next performed. If a segment is long, compared to the difference between its start vertex 
velocity and end vertex velocity, time is saved by allowing the robot 1 to first accelerate and then decelerate along tiie 
35 segment This is equivalent to adding the vertices 11-17, as shown in Fig. 9. 

[0063] Because only discrete velocity indices and run lengths are valid, these are cases where the acceleration and 
deceleration ramps meet at a half-integer. 

[0064] In these cases, such as between vertices 5 and 6. two vertices are added (13 and 14) on the nearest integer 
values. 

40 [0065] There are also cases where the acceleration and deceleration ranps would meet at velocities greater tiian the 
robot can achieve. This typically will not be tiie case if the exponential velocity relation (Fig. 6) is used. For this case, 
two vertices are inserted at the maximum velocity (e.g. vertices 16 and 1 7). 

[0066] The move_compiler subroutine is repeatedly called. Each time the move_compiIer subroutine is called a new 
requested tool 14 position is supplied through global variat}les (x-requested. y-requested. z-requested). if this is the first 

45 call of a sequence, vertices 0-2 are initialized. The requested move is tested for limit violations. If necessary. It is broken 
up Into a series of smaller moves, so that 16-bit integers can be used. The Pythagorean length is computed and mate- 
rial exti'usion pump steps are computed, if required. The maximum possible velocity of ttie previous vertex is then com- 
puted. The above procedure is repeated for each call to tine move-compiler subroutine until the allocated memory is full, 
or until the routine indicates the end of the sequence. 

50 [0067] Next (after routine dump-it) extra moves to enhance material deposition are added. 
[0068] Next, the vertices are sorted by slowest velocity by the heap sort algorithm. 

[0069] Next the nearest neighbor vertices, to the slowest vertex, are tested to see if they are too fast or too slow. If 
too fast, their velocities are reduced and the heap is re-sorted. The slowest vertex is then removed from the heap and 
the procedure repeated till the heap is empty. 
55 [0070] Next one or two vertices are added along those segments that can support an acceleration followed by a 
deceleration. 

[0071] Finally the data is passed to haul Q. which generates the stepper motor pulse sequences in real time. 
[0072] Fig. 1 b illusti^ates a further embodiment of ttie invention wherein ttie operations of the haulQ routine are imple- 
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rnenled in hardware (specHically the block 26). 

[0073] In Fig. 1 b a robotic system 20 includes a vertex list 22 that is output from a trajectory generator (not shown). 
An output 22a of the vertex list provides vertices to a move compiler 24 which implements steps of the method as 
described in detail atxjve. The output 24a of the move compiler 24 is a list conprised of a number of steps for each axis. 
5 and also the speed of the master axis. Block 26 implements the functions of the haulQ routine and interpolates synchro- 
nized pulse trains for each of the axes. The output of the k^lock 26 is provided to a feedback block 28 having an output 
28a that is provided to a stepper motor driver block 30. The stepper motor driver block 30 has a plurality (n) outputs for 
driving stepper motors 1-n. 

[0074] The system 20 further include n encoders, one for each stepper motor, having outputs that are provided to an 

10 encoder data block 32. The block 32 digitizes tiie encoder outputs and provides tiiis data as in input 28b to ttie feedback 
block 28. Each encoder output is representative of a position of the associated stepper motor. 
[0075] In general, and as is indicated by the switch SWI . the system 20 operates in an open loop (OL) configuration 
when accelerating one or more of the stepper motors, and operates in a closed loop (CL) configuration if it becomes 
necessary to reposition one or more of the stepper motors. Closed loop operation may be necessary if. for example, a 

15 stepper nxstor were to stall while accelerating or deicelerating. 

[0076] In operation, the feedback block 28 compares tine expected position of each axis with its actual position, as 
indicated by ttie associated encoder data. If tiie two positions are different, and if tiie axis is not a master axis, and if 
the step rate of the axis is below a preset ttireshold, then correction steps are output by the feedback block 28 to restore 
the errant axis to ttie desired position. 

20 [0077] The interpolation block 26 may be implemented as an Application Specific Integrated Circuit (ASIC) which per- 
forms the functions of the haulQ routine in a rapid manner. The blocks 22 and 24 may be contained within an attached 
processor, such as a workstation, and ttie link 24a is ttien a communication link between ttie workstation and ttie inter- 
polation block 26 of the actual robot. The feedback block 28 may be implemented witti a separate processor ttiat per- 
forms the functions of outputting stepper motor drive signals, comparing expected versus actual positions, and 

25 generating correcting step sequences when required. 

[0078] As was noted previously, the teaching of ttiis invention is not limited to rapki prototyping systems, and is not 
limited for use only with stepper motors. For Example, the teaching of the invention can be enployed witti synchronous 
motors wherein each motor Is provided with closed loop control through the use of an encoder or similar feedback sen- 
sor. In this case the minimum resolvable distance, 0,0127 mm for example (one half mil), Is employed as a "step size", 

30 and ttie command stream output by ttie move compiler is used an an input to each synchronous motor/encoder combi- 
nation. The use of ttie invention enables ttie closed loop gain to be decreased, ttiereby improving stability, while provkJ- 
ing ttie benefit of preprocessing ttie required trajectories to enable rapid and globally optimal positioning. 

Claims 

35 

1 . A mettiod for reducing a time required for an object to be driven by a plurality of motors over a predetermined tra- 
jectory ttirough an n-dimensional space, wherein n is equal to or greater ttian two, the trajectory being defined by 
a plurality of vertices each having coordinates that define a location within the n-dimensional space, characterized 
by the steps of: 

40 

providing a set of vertices that define a desired trajectory, each vertex being separated from at least one other 
vertex by a line segment: 

for each vertex, determining a maximum velocity that can fc>e sustained while translating the object through a 
45 point in the trajectay that corresponds to the vertex; 

modifying ttie vertex list, if required, to achieve a velocity profile over ttie trajectory that causes the object to 
traverse the trajectory in the shortest period of time, without exceeding the maximum velocity at any vertex; 
and 

50 

ti'anslating the modified vertex list into motor drive signals for causing the plurality of motors to translate ttie 
object in accordance witti ttie ntodif ied vertex list. 

2. The mettiod as set forth in claim 1. wherein the motors are stepper motors ttiat move a step distance of d in 
55 response to drive signal pulse, wherein translating tfie object through a point in the trajectory from a vertex i-1 to i 

to M results in a deflection of angle 0;. and wherein a value of cose, is employed to determine a delay time 
between drive signal pulses for a stepper motor associated with an axis having a fastest movement. 
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TTie method as set forth in daim 2. wherein the step of modifying includes the steps of: 

determining a velocity profile over a run length corresponding to the desired trajectory, the velocity profile being 
determined in accordance with a dynamic characteristic of the stepper motor; 

testing an effect of maximum accelerations and maximum decelerations between pairs of vertices to determine 
if a resulting velocity would exceed the determined maximum velocity at one of the vertices of the pair; and 

adjusting the velocities of vertices to enable the use of maximum accelerations and decelerations between ver- 
tices, and inserting, if required, one or more intermediate vertices between the vertices of the pair. 

The method as set forth in daim 3 wherein the dynamic characteristic is torque. 

The method of claim 1 . comprising the steps of: 

(a) detenmininig a maximum velocity that can be maintained for each vertex as the object changes direction 
when being driven from one fine segment to the next; 

(b) sorting the vertices by ascending maximum velocity; 

(c) examining a pair of vertices consisting of the slowest vertex and a subsequent vertex in the trajectory; 

if the determined maximum velodty at the subsequent vertex is found to be exactly achieved by accelerating 
as fast as possible from the slowest vertex, 

(d) marking determined maximum velocity at the subsequent vertex as correct: 

if the determined maximum velocity at the subsequent vertex ts found to be greater than the determined max- 
imum velocity. 

(e) reducing the maximum velocity for the sut>sequent vertex to the value achieved by accelerating as fast as 
possible from the slowest vertex; and 

(f) marking the reduced maximum velocity at the suljsequent vertex as con-ect; 

if the determined maximum vetocity at the subsequent vertex is found to be less than the determined maximum 
velocity. 

(g) marking the sut>sequent vertex for a subsequent addition of at least one intermediate vertex; 

(h) examining a pair of vertices consisting of the slowest vertex and a previous vertex in the trajectory; 

if the determined maximum velodty at the slowest vertex is found to t>e exactly achieved by decelerating as fast 
as possible from the previous vertex to the slowest vertex. 

(i) marking the maximum velocity at the previous vertex as correct; 

if the determined maximum velocity at the previous vertex is found to be greater than the determined maximum 
velocity. 

G) reducing the maximum velocity for the previous vertex to the value achieved by decelerating as fast as pos- 
sible from previous vertex to the skwest vertex; and 

(k) marking the reduced maximum velocity of the previous vertex as correct; 

if the determined n^imum velocity at the subsequent vertex is found to be less than the determined maximum 
velocity, 

(I) marking the previous vertex for a subsequent addition of at least one intermediate vertex; 
(m) removing the vertex having the lowest maximum velocity from the vertex list; 
(n) determining if all vertex pairs have been examined; 
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(0) if NO, repeating the steps (b) through (n); else 

(p) if YES. adding at least one intermediate vertex between each vertex pair previously marked for vertex addi- 
tion; and 

5 

(q) determining from the resulting vertex list a sequence of motor control signals so as to cause the object to 
be driven over the trajectory so as to achieve the indicated velocities at each vertex of the resulting vertex list. 

6. The method as set forth in claim 5. wherein the motors are stepper motors, and wherein the step (q) adds a single 
10 vertex if a full acceleration from the first of the pair of vertices, and a full deceleration to the second of the pair of 
vertices, results in a position, along the line segment connecting the pair of vertices, where the accelerating and 
decelerating velocities are the same, and which is an integer number of stepper motor steps from lx>th vertices, and 
where the velocity at the intersection is less than a maximum allowable velocity. 

1$ 7. The method as set forth in claim 5. vtfherein if a full acceleration, followed by full deceleration, along the line seg- 
ment between the pair of vertices will cause the velocity to reach a maximum allowable velocity, the step (q) adds 
a first vertex at a point on the line segment where the velocity first reaches the maximum allowable value, and a 
second vertex at a point on the line segment whereat a full acceleration will result in the second vertex being 
reached at the determined maximum velocity. 

20 

8. The method as set forth in claim 7. wherein the motors are stepper motors, and wherein if a full acceleration ranp 
and a full deceleration ramp intersect at a non-integer number of stepper motor steps, the step (q) adds two verti- 
ces along the line segment that are separated by one stepper rnoXor step that results in neither an acceleration or 
a deceleration. 

25 

9. The method as set forth in daim 5. wherein the step (b) is accomplished with a heap sort. 

10. The method as set forth in daim 5. wherein the motors are stepper motors, wherein translating the object through 
a point in the trajectory from a vertex i-1 to i to i+1 results in a deflection of angle 6j, and wherein step (a) employs 

30 a value of cose j to determine the maximum velocity for the vertex i. 

PatentansprOche 

1. Verfahren zum Reduzieren einer Zeit. die erforderlich ist. um ein Objekt durch mehrere Motoren auf einer vorbe- 
35 stimmten Bahn in einem n-dimensionalen Raum anzutreiben. wobei n gleich Oder grOBer als zwei ist und wobei die 

Bahn durch eine Vielzahl von Scheitelpunkten definiert ist, die jewels Kbordinaten haben. weiche einen Ort inner- 
halb des n-dimensionalen Raums def inieren. gekennzeichnet durch die Schritte: 

Bereitstellen einer Schar von Scheitelpunkten. die eine gewunschte Bahn definieren. wobei jeder Scheitel- 
40 punki von wenigstens einem anderen Scheitelpunkt durch einen Streckenabschnitt getrennt ist; 

fur jeden Scheitelpunkt. Bestimmen einer maximalen Geschwindigkeit, die ausgefuhrt werden kann. wfthrerKl 
sich das Objekt durch einen Punkt auf der Bahn bewegt, welcher dem Scheitelpunkt entspricht: 

45 Modifizieren der Scheitelpunktliste, bei Bedarf, um ein Geschwindigkeitsprofil uber der Bahn zu erzielen. wel- 

ches bewirkt. daB das Objekt die Bahn in der kurzesten Zeitspanne zurQcMegt, ohne die maximale Geschwin- 
digkeit in irgendeinem Scheitelpunkt zu Qberschreiten; und 

Umsetzen der modifizierten Scheitelpunktliste in Motoransteuersignate, weiche bewirken. daB die Motoren 
50 das Objekt gemdB der modifizierten Scheitelpunktliste verschieben. 

2. Verfahren nach Anspruch 1, wobei die Motoren Schrittmotoren sind, die sich um eine Schrittdistanz d aufgrund 
eines Ansteuersignalimpulses bewegen. wobei das Verschieben des Objekts durch einen Punkt auf der Bahn von 
einem Scheitelpunkt i-1 bis i bis i+1 in einer Ablenkung um einen Winkel Oj resuttiert und wobei ein Wert von cos 6; 

55 benutzt wind, um eine VerzOgerungszeit zwischen Ansteuersignalimpulsen fur einen Schrittmotor zu bestimmen, 
der einer Achse zugeordnet ist. die eine schnellste Bewegung hat 

3. Verfahren nach Anspruch 2, wobei der Schritt des Modifizierens die Schritte beinhaltet: 
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Bestimmen eines Geschwindigkeitsprofits Ober einer Laufldnge^ die der gewOnschten Bahn entsphcht wobei 
das Qeschwindigkeitsprofn gemdB einer dyoamischen Etgenschaff des Schrittmotors bestimmt wird; 

Testen einer Auswirkung von mciximalen Beschleunigungen und maxiniaten Verlangsamungen zwischen Paa- 
ren von Scheitetpunkten, urn festzustellen ob eine resuttierende Geschwindigkeit die vortestimmte Maximal- 
geschwindigkeit in einem der Scheitelpunkte des Paares Obersteigen wOrde: und 

Einsteilen der Geschwindigkelten von Schettelpunkten. urn die Benutzung von maximalen Beschleunigungen 
und Verlangsamungen zwischen Scheitetpunkten zu ermOgiichen. und Einfugen. bei Bedarf. von einem Oder 
mehreren Zwischenscheitelpunkten zwischen den Scheitelpunkten des Paares. 

Verfahren nach Anspruch 3. wobei die dynamische Eigenschaff das Drehmoment ist. 

Verfahren nach Anspruch 1, beinhaltend die Schritte: 

(a) Ermittein einer maximalen Geschwindigkeit, die fQr jeden Scheitetpunkt aufrechterhalten werden kann. 
wenn das Objekt die Rrchtung dndert. wenn es von einem Streckenabschnitt zum ndchsten angetrieben wird; 

(b) Sortieren der Scheitelpunkte nach aufsteigender maximaler Geschwindigkeit; 

(c) PrOfen von einem Paar Scheitelpunkten. das aus dem langsamsten Scheitelpunkt und einem anschlieBen- 
den Scheitelpunkt auf der Bahn besteht; 

wenn es sich zeigt, da6 die ermittelte maximale Geschwindigkeit in dem anschtieBenden Scheitelpunkt exakt 
erreicht wird. indem so schnell wie mOglich von dem langsamsten Scheitelpunkt aus beschleunigt wird. 

(d) Markieren der ermittelten maximalen Geschwindigkeit in dem anschlieBenden Scheitetpunkt als korrekt; 
wenn es sich zeigt. da3 die ermittelte maximale Geschwindigl^ in dem anschlieOenden Scheitelpunkt grC6er 
als die ermittelte maximale Geschwindigkeit ist. 

(e) Reduzieren der maximalen Geschwindigkeit fOr den anschlieBenden Scheitelpunkt auf den Wert, der 
erzielt wird. irxlem von dem langsamsten Scheitelpunkt aus so schnell wie mOglich beschleunigt wird; 

(f) Markieren der reduzierten maximalen Geschwindigkeit in dem anschlieBenden Scheitelpunkt als korrekt; 
wenn es sich zeigt, daB die ermittelte maximale Geschwindigkeit in dem anschlieBenden Scheitelpunkt nied- 
riger als die ermittelte maximale Geschwindigkeit ist. 

(g) Markieren des anschlieBenden Scheite^nktes fQr eine anschlieBende Addition von wenigstens einem 
Zwischenscheitelpunkt; 

(h) Prufen von einem Paar Scheitelpunkten^ das aus dem langsamsten Scheitelpunkt und einem vorhergehen- 
den Scheitelpunkt auf der Bahn besteht; 

werm es sich zeigt, daB die ermittelte maximale Geschwindigkeit in dem langsamsten Scheitelpunkt exakt 
erreicht wird. indem so schnell wie mOglich ab dem vorhergehenden Scheitelpunkt bis zu dem langsamsten 
Scheitelpunkt verlangsamt wird. 

(i) Markieren der maximalen Geschwindigkeit in dem vorhergehenden Scheitelpunkt als korrekt; 

wenn es sich zeigt, daB die ermittelte maximale Geschwindigkeit In dem vorhergehenden Scheitelpunkt grOBer 
als die ermittelte maximale Geschwindigkeit ist, 

(j) Reduzieren der maximalen Geschwindigkeit fur den vorhergehenden Scheitelpunkt auf den Wert, der 
erreicht wird. indem so schnell wie mOglich ab dem vorhergehenden Scheitelpunkt bis zu dem langsamsten 
Scheitelpunkt verlangsamt wird; und 

(k) Markieren der reduzierten maximalen Geschwindigkeit des vorhergehenden Scheitelpunktes als korrekt; 
wenn es sich zeigt. daB die ermittelte maximale Geschwindigkeit in dem anschlieBenden Scheitelpunkt kleiner 
als die ermittelte maximale Geschwindigkeit ist, 

(I) Markieren des vorhergehenden Scheitelpunktes fur eine anschlieBende Addition von wenigstens einem 
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Zwischenscheitelpunkt; 

(m) Entfernen des Scheitelpunktes^ der die niedrigste maximaie Geschwindigkeit hat, aus der Scheitelpunktli- 
ste; 

5 

(n) Feststellen, ob alle Scheitelpunktpaare geprOft worden sind; 

(o) wenn NEIN, Wiedertiolen der Schrrtte (b) bis (n); sonst 

10 (p) wenn JA. Addieren von wenigstens einem Zwischenscheitelpunkt zwtschen jedem Scheitelpunktpaar. das 

zuvor for die Scheitelpunktadditlon markiert worden ist; und 

(q) Ermittefn einer Sequenz von Motorsteuersignalen aus der resultierenden Scheitelpunktliste, urn so zu 
bewirken. da3 das Objekt so auf der Bahn angetrieben wird, daB die angezeigten Geschwindigkeiten in jedem 
15 Scheitelpunkt der resultierenden Scheitelpunktiste erzielt werden. 

6. Verfahren nach Anspruch 5, wobei die Motoren Schrittnrwtoren sind und wobei der Schritt (q) einen einzelnen 
Scheitelpunkt addiert wenn eine voile Beschleunigung ab dem ersten Scheitelpunkt des Paares von Scheitelpunk- 
ten und eine voile Verlangsamung bis zu dem zweiten Scheitelpunkt des Paares von Scheitelpunkten in einer Posi- 
20 tk>n Idngs des Streckenabschnrtts resuitiert weicher das Paar von Scheitelpunkten verbindet, wo die 
Beschleunigungs- und Verlangsamungsgeschwindigteiten dteselben sind. und welches eine ganze Zahl von 
Schrittmotorschritten von beiden Scheitelpunkten aus ist, und wo die Geschwindigkeit in dem Schrattpunkt kteiner 
ist als eine maximal zuldssige Geschwindigkeit. 

25 7. Verlahren nach Anspruch 5. wobei. wenn eine voile Beschleunigung. gelblgt von einer vollen Verlangsamung. 
langs des Streckenabschnitts zwischen dem Paar Scheitelpunkten bewirken wird. da6 die Geschwindigkeit eine 
maximal zuiassige Geschwindigkeit erreicht. der Schritt (q) einen ersten Scheitelpunkt in einem Punkt auf dem 
Streckenabschnitt addiert. wo die Geschwindigkeit zum ersten Mai den maximal zuldssigen Wert erreicht, und 
einen zweiten Scheitelpunkt in einem Punkt auf dem Streckenat)schnitt. ab welchem eine voile Beschleunigung 

30 dazu fOhren wird, daB der zweite Scheitelpunkt mit der ermittelten maximalen Geschwindigkeit erreicht wird. 

8. Verfahren nach Anspruch 7, wobei die Motoren Schrittmotoren sind, und wot^i, wenn eine voile Beschieunigungs- 
rampe und eine voile Verlangsamungsrampe sich in einer unganzzahligen Zahl von Schrittmotorschritten schnei- 
den. der Schritt (q) zwei Scheitelpunkte Idngs des Streckenabschnitts addiert. die durch einen Schrittmotorschritt 

35 getrennt sind, der weder zu einer Beschleunigung noch zu einer Verlangsamung fOhrt. 

9. Verfehren nach Anspruch 5, wobei der Schritt (b) mit einer Gruppensortlerung ausgefOhrt wird. 

10. Verfahren nach Anspruch 5, wobei die Motoren Schrittmotoren sind, wobei das Bewegen des Objekts durch einen 
40 Punkt auf der Bahn von einem Scheitelpunkt 1-1 bis i bis zu einer Ablenkung um einen Winkel Q\ fuhrt und Wobei 

der Schritt (a) einen Wert von cos e j verwendet. um die maximaie Geschwindigkeit fQr den Scheitelpunkt i zu 
ermitteln. 

Revendications 

45 

1. Proc6d6 pour r^duire le temps exig6 pour qu'un objet soit entraTn6 par une plurality de moteurs sur une trajectoire 
pr§d6termin6e ^ travers un espace k n dimensions, n ^ant 6gal ou sup^rieur d deux, la trajectoire ^tant d6finie par 
une plurality de sommets ayant chacun des coordonn6es qui d§finissent un emplacement dans I'espace ^ n 
dimensions. caract6ris6 en ce qu'il comprend les 6tapes consistant ^ fournir un ensemble de sommets qui d6finis- 

50 sent une trajectoire d^sir^e. chaque sommet 6tant s6par6 d'au moins un autre sommet par un segment de ligne, 
ti d^erminer. pour chaque sommet. une Vitesse maximaie qui peut etre maintenue lors du passage de Tobjet par 
un point sur la trajectoire qui correspond au sommet, k modifier, si n6cessaire. la liste des sommets pour obtenir 
un profil de vitesse, sur la trajectoire, qui am^ne Tobjet k parcourir la trajectoire dans la plus courte p^riode de 
temps, sans d6passer la vitesse maximaie k un sommet quelconque, et k convertir la liste des sommets modifi^e 

55 en signaux d'attaque des moteurs pour amener la plurality de moteurs k d^placer Tobjet en accord avec la liste des 
sommets modifi^e. 

2. Proc6d6 suivant la revendication 1 caract6ris6 en ce que les moteurs sont des moteurs pas k pas qui se d^lacent 
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d*une distance de pas d en r6ponse d una impulsion de signal d'attaque. le passage de I'objet par un point sur la 
trqjectoire. d'un sommet Wkun sonrmiet i puis d un sonrvnet i+1 . se traduit par une deviation d*un angle Oj, et une 
valeur de cos Oj est employee pour determiner un temps de retard entre des inpulsions de signal d'attaque pour 
un moteur pas d pas associ6 h un axe ayant le mouvement le plus rapide. 

5 

3. Proc^6 suivant la revendication 2 caract^ls6 en ce que T^tape de modification conrporte les stapes consistent k 
determiner un profil de vitesse sur une longueur de course correspondant k la trajectoire d^sir^e, le profil de 
Vitesse etant determine en accord avec une caracteristique dynamique du moteur pas k pas, k tester un effet 
d*acceierations maximales et de decei^ations maximales entre des paires de sommets afin de determiner si une 
10 Vitesse resultante depasserait la vitesse maximale determinee k Tendroit de Tun des sommets de la paire. et k 
ajuster les vitesses des sommets de maniere k permettre Tutilisation d'acceierations et decelerations maximales 
entre les sommets et a inserer, si necessaire, un ou plusieurs sommets intermediaires entre les sommets de la 
paire. 

15 4. Precede suivant la revendication 3 caracterise en ce que la caracteristique dynamique est le couple. 

5. Precede suivant la revendication 1 caracterise en ce qull comprend les etapes consistent : 

(a) k determiner une vitesse maximale qui peut etre maintenue pour cheque sommet tandis que Tobjet change 
20 de direction lorsqu'il est entralne d'un segment de ligne au segment suivant: 

(b) k trier les sommets dans Tordre de leur vitesse maximale croissante; 

(c) k examiner une paire de sommets constituee par le sommet le plus lent et un sommet subsequent dans la 

trajectoire; 

si la Vitesse maximale determinee k I'endroit du sommet subsequent est trouvee etre atteinte exactement en 
25 accelerant aussi rapidement que possible k partir du sommet le plus lent, 

(d) k marquer la vitesse maximale determinee k Tendroit du sommet subsequent comme etant con'ecte; 

si la vitesse maximale determinee k I'endroit du sommet subsequent est trouvee etre superieure k la vitesse 
maximale determinee. 

(e) k reduire la vitesse maximale pour le sommet subsequent k la valeur atteinte par une acceleration aussi 
30 rapide que possible k partir du sommet le plus lent ; et 

(f) k marquer la vitesse maximale reduite k I'endroit du sommet subsequent comme etant correcte; 

si la Vitesse maximale determinee k I'endroit du sonvnet sut>sequent est trouvee etre interieure k la vitesse 
maximale determinee, 

(g) k marquer le sommet subsequent en vue d'une addition subsequente d'au moins un sommet intermediaire; 
35 (h) k exantiner une paire de sommets constituee par le sommet le plus lent et un sommet precedent dans la 

trajectoire: 

si la Vitesse maximale determinee k I'endroit du sommet le plus lent est trouvee etre atteinte exactement par 
une deceleration aussi rapide que possible k partir du sommet precedent jusqu'au sommet le plus lent, 
(i) k marquer la vitesse maximale k I'endroit du sommet precedent comme etant correcte; 
40 si la Vitesse nriaximale determinee k I'endroit du sommet precedent est trouvee §tre superieure k la vitesse 

maximale determinee, 

(1) k reduire la vitesse maximale pour ie sommet precedent k la valeur atteinte par une deceleration aussi 
rapide que possible k partir du sommet precedent jusqu'au sommet le plus lent; et 
(k) k marquer la vitesse maximale reduite du sommet precedent comme etant correcte; 
45 si la Vitesse maximale determinee k I'endroit du sommet sut>sequent est trouvee etre interieure k la vitesse 

maximale determinee. 

(I) k marquer le sommet precedent en vue dune addition subsequente d'au moins un sommet intermediaire: 
(m) k supprimer le sommet ayant ia vitesse maximale la plus basse de la tiste des sommets; 
(n) k determiner si toutes les paires de sommets ont 6t6 examinees; 
50 (o) si la reponse est NON, k r^eter les etapes (b) k (n); 

(p) si la reponse est OUI. k ajouter au mdns un sommet intermediaire entre cheque paire de sommets prece- 
demment marques en vue d'une addition d'un sommet; et 

(q) k determiner, k partir de ia liste des sommets resultante, une sequence de signaux de commande des 
moteurs de maniere k amener I'objet k etre entraTne suivant la trajectoire afin d'atteindre les vitesses indiquees 
55 k I'endroit de chaque sommet de la liste des sommets resultante. 

6. Proc6d6 suivant la revendication S caracterise en ce que les moteurs sont des moteurs pas k pas et retape (g) 
ajoute un seul sommet si une acceleration totale k partir du premier sommet de la paire de sommets et une dece- 
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l^ration totafe vers le second sommet de la paire de sommets se traduit par une position, le long du segment de 
(Igne oonnectant la paire de sommets, ou les vitesses d'acc^t^ration et d6c6l6ratton sont les m6mes. et qui est un 
nombre entier de pas des moteurs pas pas & partir des deux sommets. et oD la vitesse k llntersection est inf 6- 
rieure d une vitesse maximale admissit)la 

5 

7. Proc6d6 suivant la revendicatlon 5 caract6ris6 en ce que si une acclimation totale, suivie par une d6c6l6ration 
totale. le long du segment de ligne entre.la paire de sommets am^ne la vitesse k atteindre une vitesse maximale 
admissil)le. r6tape (q) ajoute un premier sommet k Tendroit d'un point, sur le segment de ligne. ou la vitesse atteint 
en premier la vitesse maximale admissftile, et un second sommet en un point, sur le segment de ligne, ou une 

10 acceleration totale se traduit par le fait que le second sommet est atteint ^ la vitesse maximale d^termin^e. 

8. Precede suivarrt ta revendication 7 caracterise en ce que les moteurs sont des moteurs pas k pas et si une rampe 
d'acceieration totale et une rampe de deceleration totale se recoupent d Tendrort d un nombre non entier de pas 
des nfX)teurs pas k pas. retape (q) ajoute. le long du segment de ligne. deux sommets qui sont separes par un pas 

15 des moteurs pas k pas, ce qui se traduit par ni une acceleration ni une deceleration. 

9. Procede suivant la revendication 5 caracterise en ce que retape (b) est accomplie avec un tri en tas. 

10. Procede suivant la revendication 5 caracterise en ce que les moteurs sont des moteurs pas k pas. le passage de 
20 I'objet par un point sur la trajectoire, d'un sommet i-l k un sommet i puis k un sommet i+1 se traduit par une devia- 
tion d'un angle Oj. et une valeur de cos 0 , est employee dans retape (a) pour deternvner la vitesse maximale pour 
le sommet i. 
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CLAIMS 

1. A visually controlled robot system comprising: 
a robot control device for controlling an 
operation of a robot body: 
5 a vision sensor system for detecting visual 

Information: and 

a common operator panel having means for selecting 
one of a first mode for carrying out an operation 
related to said robot control device and a second mode 
10 for carrying out an operation related to said vision 
sensor system." to carry out said operations. 

2 A visually controlled robot system according 
to claim 1. wherein said vision sensor system includes 
a Vision sensor for imaging at least a subject of work. 
15 and a vision sensor controller for analyzing a picture 
Signal from said vision sensor, said vision sensor 
controller being connected to said operator panel. 

3. A visually controlled robot system according 
to claim 1. wherein an operation common to said first 
20 and second modes is executed through an identical 
operation of the operator panel by an operator. 

4 A visually controlled robot system according 
to any one of claims 1 to 4. wherein a welding torch is 
mounted to said robot body to carry out arc welding. 



